A SYSTEM AND METHOD FOR DETECTING ROLL RATE SENSOR 

FAULT 

RELATED APPLICATION 

The present invention claims priority to provisional 
application no. 60/400,155 filed on August 1, 2002, 
the disclosure of which is incorporated by reference 
herein. 

Technical Field 

[0001] The present invention relates generally to 
automotive vehicle sensors, and more specifically, to 
a method and apparatus for detecting a roll rate 
sensor fault. 

Background 

[0002] Current, rollover stability control (RSC) 
schemes address vehicle roll and include a variety of 
sensors sensing vehicle dynamic conditions. RSC 
systems further include a controller controlling a 
distributed brake pressure for reducing a tire moment 
such that the net moment of the vehicle is counter to 
the vehicle roll direction. 

[0003] The RSC sensors include a speed sensor, a 
lateral acceleration sensor, a roll rate sensor, and a 
yaw rate sensor. The roll rate sensor is typically 
utilized to estimate the roll angle and to calculate 
the desired control pressure. Fault modes of the roll 
rate sensor, therefore, may cause unintended braking, 
reduced performance or even loss of stability. Such 
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fault modes must be rapidly diagnosed and indicated so 
that the RSC system is shut down. 

[0004] U.S. Pat. No. 6,315,373 addresses a 
similar issue of fault detection for a roll control 
device. It, however, merely addresses the detection 
of a lateral accelerometer in a system that uses 
lateral acceleration signals to detect vehicle roll 
over stability, which is insufficient for a 
comprehensive RSC system. Furthermore, this method 
relies heavily on the vehicle suspension model. 
Variations of the suspension parameters, such as the 
spring stiffness and damping ratio, may cause an 
unnecessary false warning (i.e. false positive) or a 
missed detection (i.e- false negative). 

[0005] It is therefore desirable to provide a 
system that rapidly detects a roll rate sensor fault 
in a rollover stability control system that can be 
applied to various vehicle platforms without tuning. 
This method should also be able to detect a fault 
independent of the specific fault modes as well as 
detect a fault that is otherwise not detectable by 
checking electrical specifications. 

Summary of the Invention 

[0006] In one aspect of the invention, a control 
system for an automotive vehicle having a vehicle body 
includes a sensor cluster having a housing oriented 
within the vehicle body. A roll rate sensor is 
positioned within the housing and generates a roll 
rate sensor signal corresponding to a roll angular 
motion of the sensor housing, A controller receives 
the roll rate sensor signal and generates a reference 
roll angle. The controller also compares the 
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reference roll angle to the roll rate sensor signal 
and generates a roll rate sensor fault signal in 
response a fault determined in said roll rate sensor. 

[0007] In a further aspect of the invention, a 
method for detecting a roll rate sensor fault includes 
generating a reference roll angle, generating a roll 
rate sensor signal, comparing the reference roll angle 
to the roll rate sensor signal, and generating a roll 
rate sensor fault signal . 

[0008] One objective of the present invention is to 
provide a method for fault detection of a roll rate 
sensor onboard a vehicle. Sensor fault is not always 
detectable by sensor self test and/or system 
electronic monitoring, having detection relying on the 
fault to violate sensor specification. Because an in- 
range signal fault may occur, a redundancy check is 
included for a safety critical system. The proposed 
methodology is to provide such a redundancy check 
through software/analytical redundancy. 

[0009] The present invention utilizes steering 
wheel angle, yaw rate, lateral acceleration, and 
vehicle speed signals to verify roll rate signal. 
Following the detection, the system, utilizing the 
roll rate signal may decide to directly shutdown, 
slowly shutdown, or use a different signal to operate 
in order to minimize negative effect. 

[0010] The present invention utilizes both 
kinematics and dynamics relations among sensor signals 
and is robust to variation of suspension parameters 
and unavoidable biases in reference signals. It 
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detects faults independent of the specific fault mode 
and detects faults that are otherwise not detectable. 

[0011] Other advantages and features of the present 

invention will become apparent when viewed in light of 
the detailed description of the preferred embodiment 
when taken in conjunction with the attached drawings 
and appended claims. 

Brief Description Of The Drawings 

[0012] Figure 1 is a diagrammatic view of a vehicle 
with variable vectors and coordinator frames in 
accordance with one embodiment of the present 
invention. 

[0013] Figure 2 is a block diagram of the vehicle 
sensor system from Figure 1 . 

[0014] Figure 3 is a logic flow diagram of a method 
for signal compensation of the roll rate signal for 
all 'valid' biases in accordance with another 
embodiment of the present invention. 

[0015] Figure 4 is a logic flow diagram of a method 
for detecting a roll rate sensor fault in accordance 
with another embodiment of the present invention. 

Description Of The Preferred Embodiment 

[0016] In the following figures the same reference 
numerals will be used to identify the same components. 
The present invention is preferably used to detect 
roll rate sensor fault in conjunction with a dynamic 
control system for an automotive vehicle, such as a 
yaw control system or a rollover control system. 
Howeiver, the present invention may also be used to 
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detect roll rate sensor fault in any vehicle system 
including a roll rate sensor. 

[0017] Referring to Figures 1 and 2, a safety 

system 18 for an automotive vehicle 19 having a 
sensing system 16 (sensing cluster) , including a roll 
rate sensor 31, and a controller 26, is illustrated. 
Various forces and moments are acting thereon during a 
rollover condition . 

[0018] The vehicle safety system 18 includes the 

sensor system 16, The sensing system 16 may use a six 
control sensor set including three axial 
accelerometers including a lateral accelerometer 27, a 
longitudinal accelerometer 28, and a vertical 
accelerometer 29 and three axial rotation rate 
detectors including a yaw rate sensor 30, a roll rate 
sensor 31, and a pitch rate sensor 32. The sensor 
system 16 further includes various other sensors, such 
as wheel speed sensors 20, a steering angle sensor 33 
(hand-wheel sensor) , and steering angle position 
sensors 34 (road-wheel sensors) . The various sensors 
will be further described below. 

[0019] The vehicle safety system 18 includes the 
roll rate sensor 31 positioned within the housing of 
the vehicle safety system 18. The roll rate sensor 
31 generates a roll rate sensor signals corresponding 
to a roll angular motion of the sensor housing. 

[0020] The vehicle safety system 18 also includes 
the controller 26. The controller 26 receives the 
roll rate sensor signals, generates a reference roll 
angle, and compares the reference roll angle to the 
roll rate sensor signal- The controller also 
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generates a roll rate sensor fault signal in response 
to a fault determined in the roll rate sensor. 

[0021] Based upon inputs from the sensor system 16, 

the controller 26 may control a safety device 38. 
Depending on the desired sensitivity of the system and 
various other factors , not all the sensors is used in 
a commercial embodiment. The safety device 3 8 may 
control an airbag 40 or a steering actuator or braking 
actuator at one or more of the wheels of the vehicle. 
Also, other vehicle components such as a suspension 
control 48 are used to adjust the suspension to 
prevent rollover. Suspension control 48 may include 
an anti-roll bar. 

[0022] Generally, the vehicle 19 has a weight 
represented as Mg at the center of gravity of the 
vehicle 19, where g = 9.Sm/s^ and M is the total mass of 

the vehicle 19. 

[0023] The reference roll angle, a vehicle roll 
angle in the inert ial frame (or the angle between 
vehicle body lateral axis and the horizon) , is 
obtained with available signals other than roll rate, 
which is the signal to be verified. This roll angle 
is an independent reference (from roll rate) of 
vehicle (global) roll angle, and is therefore termed 
the ''reference roll angle" . 

[0024] In one embodiment of the present invention, 
the reference roll angle is generated within the 
controller 26 through the kinematics relationship 
between lateral acceleration, yaw rate, vehicle 
longitudinal speed, and vehicle roll angle are 
utilized. In other words. 
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sin^ = (wr-a^)/g , 

where ^is roll angle, u is vehicle speed, r is yaw 
rate, g is gravity constant and ay is lateral 
acceleration. 

[0025] The reference roll angle is generated by 
applying steering wheel angle information to reduce 
the approximation error due to the negligence of the 
dynamic lateral velocity derivative in the above 
equation. Another embodiment of the present invention 
includes generating a reference roll angle using 
steering wheel angle from the steering angle sensor 3 3 
or steering position sensor 34, yaw rate from the yaw 
rate sensor 30, lateral acceleration from the lateral 
acceleration sensor 27, and vehicle longitudinal speed 
from the speed sensor 20 . 

[0026] Alternately, the dynamic relation between 
lateral acceleration experienced by the vehicle body 
and suspension roll motion is used to generate the 
reference roll angle. The equation representation 
thereof is : 
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[0027] After obtaining the reference roll angle, 
the roll rate signal is compensated within the 
controller 26 for all 'valid' signal biases. 

[0028] A 'valid' signal bias refers to a bias that 
may occur due to either an electrical noise within 
sensor specification and/or due to a mechanical 
disturbance from maneuvers /road conditions. 
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[0029] For example, a vehicle pitch angle during a 
turn will induce a measurement bias due to the 
difference between inertial frame and rotational 
frame. To illustrate: 

where ^ is Euler roll rate (inertial f rame) , , , 

and are the rotational rate of the body- fixed 
coordinate. That is, <i>^ is the roll rate sensor 
measurement, co^ is the yaw rate sensor measurement, and 
is the roll angle of interest. Since vehicle roll 
angle is generally small, the system 18 is concerned 
with only the third term (of the right hand side) 
which is a product of vehicle yaw rate and vehicle 
pitch angle. That is, 

[0030] (Important to note is that when a roll rate 
fault does occur during a turning maneuver, the 
compensation mechanism may attempt to compensate the 
biased roll rate signal by adapting the pitch angle in 
the above equation.) 

[0031] The vehicle roll rate signal averages to 
zero over a long period of time, therefore, electrical 
long term bias over time with a minute adjustment at 
each sampling time, 

[0032] Similarly, the mechanical, long-term sensor 
alignment pitch angle is controlled with a minute 
adjustment at each sampling time during vehicle 

turning (i.e. ^z"^^)^ Because chattering is 
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warranted with this approach, the adjustment should be 
small enough to prevent the chattering magnitude from 
exceeding the desired accuracy. The small adjustment 
restricts the adaptation speed. One skilled in the 
art will realize that the minute adjustment is only 
one possible embodiment of adjustment, and that 
numerous other methods are included in the present 
invention. Other adjustments, such as sliding mode 
control based on the basic logic/assumption described 
above, can be applied. 

[0033] Referring to FIGURE 3, a logic flow diagram 
70 of signal compensation of the roll rate signal for 
all 'valid' biases is illustrated. Logic starts in 
operation block 72 where the signals to be processed 
are pre-f iltering (e.g. with a low pass filter) . 

[0034] In operation block 74, current vehicle 
conditions are checked. In other words, a 

determination is made whether the yaw rate signal is 
of significant magnitude such that the signal to noise 
ratio in the subsequent calculation is meaningful and 
if current vehicle condition is appropriate to assume 
zero roll rate. 

[0035] In inquiry block 76, a check is made whether 
a fault has already been detected. For a positive 
response, in operation block 78, roll rate 
compensation/pitch alignment estimation is stopped if 
a fault flag is set or is suspected to prevent 
unneeded and unwanted compensation. 

[0036] Otherwise, in operation block 80, a 
compensation for electrical bias occurs with minute 
adjustments through logic, such as: 
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rollrate_compensated = rawrollrate 

of f set_straight - (yawrate*RAD2DEG) *spa_est; 

spa_est -= p__SPA_DELTA * 

(sign (rollrate_compensated*yawrat:e) ) ; 

sparest = min( MAX_SPA, max (MIN_SPA, 
spa_est) ) , 

where spa_est is the sine of the pitch angle. 

[0037] In operation block 82, the sine pitch 
estimation is low pass filtered to minimize 
undesirable chattering noises, through logic such as: 

lpf_spa = k*lpf_spa + (1-k) *spa_est . 

[0038] In operation block 84, the total roll rate 
offset due to both electrical bias (of f set_straight ) 
and mechanical bias (lpf_spa and yawrate) .is. 
calculated through logic, such as : 

of f set_dynamic=of f set_straight+ (yawrate *RAD2 
DEG) * (lpf_spa) . 

[0039] In operation block 86, the offset straight 
is updated during straight line driving (i.e. when the 
turning condition of operation block 74 , is not met) 
through logic as follows: 

rollrate__compensated=rawrollrate- 
of f set_straight ; 

of f set_straight+=p_RR_DELTA* (sign (rollrate_c 
ompensated) ) . 

[0040] Referring again to Figures 1 and 2, the 
compensated roll rate signal is compared, within the 
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controller 26, with the reference roll angle through 
kinematics relation and the dynamic interaction 
related by vehicle suspension. During the comparison, 
a fault is not declared under a plausible bias due to 
imperfect compensation (of electrical/mechanical 
disturbances) nor when the accuracy of reference 
vehicle roll angle is in question. 

[0041] The controller 26 compares a high pass 
filtered reference roll angle to a high pass filtered 
version of the integration of the compensated roll 
rate signal. When the two differ and the latter 
signal is nonzero^ a fault is suspected. 

[0042] The controller 26 compares a low pass 
filtered version of the derivative of the reference 
roll angle to the compensated roll rate signal. When 
the two differ and the roll rate is nonzero, a fault 
is suspected. 

[0043] The controller 26 ideally includes a Kalman 
filter utilizing the suspension dynamic relation 
between roll angle acceleration, roll angle rate, and 
roll angle to compare the reference roll angle and the 
compensated roll rate. 

[0044] The present invention designs an observer 
utilizing both the suspension dynamics and kinematics 
relationship between roll angle and rate. The present 
invention is robust to suspension parameters 
variations/uncertainties . 

[0045] The present invention can be described as a 
mass-spring system, i.e.: 
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where k is the (torsional) spring stiffness, or roll 
stiffness of the suspension, and c is the (roll) 
damping coefficient (of the suspension) . Because the 
roll stiffness and damping of a vehicle maybe non- 
linear and may vary between vehicles and between 
configurations, these parameter uncertainties are 
lumped into another term in the aforementioned 
equation as d and are viewed as disturbances. Because 
the measurement can be defined as any linear 
combination of roll angle and roll rate, the C matrix 
in the equation above is left as design parameters. 
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and 

TP - L- 

roll rate err->residue . i * 

[0046] Defining the observer output as 'residue' 
causes a roll rate fault to appear as a residue in the 
observer output while a roll angle 'measurement' error 
appears as only a transient noise. Moreover, 
suspension characteristic changes, modeled as 
disturbance d, do not affect the observer output. 
Resultantly the same observer design can be applied to 
various vehicle platforms without tuning. 

[0047] If the residue exceeds a pre-calibrated 
threshold, (which can be a pre-calibrated function of 
vehicle dynamic status,) a fault is suspected. 

[0048] If a fault condition is indicated during the 
aforementioned comparison for a short period of time, 
having a pre-calibrated length, during which time the 
system did not detect any fault from the source signal 
that generated reference roll angle, then a roll rate 
sensor fault is concluded. Alternately, to facilitate 
a faster detection, a condition is added to check if 
roll rate signal is away from zero (which is the 
noirmal value) during this period. 

[0049] Special fault detection: for sticky signal 
fault such that the roll rate signal sticks to a 
constant value, the following logic is developed: 

If (abs (high pass filtered rollrate) < 
threshold_l) holds true for more than a 
precalibrated constant. 
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(abs (high pass filtered suspension roll 
angle (from lateral acceleration) )> 
threshold__2) holds true for more than a 
precalibrated constant (not necessarily 
continuously) , 

then a fault is suspected. If this 

suspected situation has happened for more 
than a precalibrated number of times, set 
the fault flag. 

[0050] Following detection of a roll rate sensor 
fault, the controller 26 responds by either shutting 
down the safety system 18 or any of the sub-systems of 
the safety system 18, such as roll -over control and 
compensation. Alternately, the controller 26 responds 
to roll rate sensor error by compensating for 
information that would normally be obtained from the 
roll rate sensor 31. In one embodiment^ the 

controller 26 compensates for the roll rate sensor 
using signals from a combination sensors including, 
but not limited to: the lateral accelerometer 27, the 
longitudinal accelerometer 28, the vertical 
accelerometer 29, the yaw rate sensor 30, the pitch 
rate sensor 32, the wheel speed sensors 20, the 
steering angle sensor 33 (hand-wheel sensor) , and 
steering angle position sensors 34 (road-wheel 
sensors) . Regardless of the controller response to 
roll rate fault, a further embodiment of the present 
invention includes a driver notification of roll rate 
sensor problems . 

[0051] Referring now to Figure 4, a logic flow 
diagram 100 of a method for detecting a roll rate 
sensor fault is illustrated. Logic starts in 



14 FGT 1685 PA (202-0002) 



operation block 102, where a reference roll angle is 
generated from available signals other than the roll 
rate signal, as was discussed previously. 

[0052] In operation block 104, a roll rate sensor 
signal is generated from the roll rate sensor. 

[0053] In operation block 106, the reference roll 
angle is compared to the roll rate sensor signal. In 
operation block 108, a roll rate sensor fault signal 
is generated. 

[0054] In operation, a method for detecting a . roll 
rate sensor fault includes generating a reference roll 
angle in an inertial frame with available signals 
other than roll rate, generating a roll rate sensor 
signal, compensating the roll rate sensor signal for 
all valid signal biases, comparing the reference roll 
angle to the roll rate sensor signal through a 
kinematics relation and a dynamic interaction related 
by a vehicle suspension, and generating a roll rate 
sensor fault signal. 

[0055] while particular embodiments of the 
invention have been shown and described, numerous 
variations and alternate embodiments will occur to 
those skilled in the art. Accordingly, it is intended 
that the invention be limited only in terms of the 
appended claims . 



15 FGT 1685 PA (202-0002) 



